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Dio Haltevorrichtung fur die Eiemente (2) einer Dammung, 
die mit Abstand leicht demohtierbar vor einer aufrechten 
Wandangeordnet 1st und deren Eiemente sich mit einer Stu- 
fonaiisbildung (7) am Sto& teilweise uberlappen, besteht 
aus zwei Hakenteilen (8, 9) mit einem nach unten offenen 
Hakenmaul{11), die an don Elomenton (2) befestigt sind und 
aus oinem Bolzen (12), der in horizontaten Schtitzen (15) 
zweier StOtzlager (13. 14) beweglich gefuhrt ist (Rg. 2). 
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PT-Ka/kn 14.12.1984 

ROBERT BOSCH GmbH, 7000 Stuttgart 1 

Verfahren zur Umwandlung des Ausgangssi gnal s eines 
Drehgeschwi ndikei tsmeBwertgebers in ein storungsarmes Signal 

Anspruche 

1. Verfahren zur Umwandlung eines in seiner Amplitude und 
Frequenz von eijier zu ermi ttel nden, sich andernden Drehge- 
schwi ndi gkei t abhangigen, storbehaf teten si nusf ormi gen Aus- 
gangssignals eines Drehgeschwi ndi gkei t-MeSwertgebers in ein 
storungsarmes Signal, dadurch gekennzei chnet , daB ein 
Kalman-Fil ter in der Weise zum Einsatz kommt, 

a) daB in vorgegebenen Zei tabstanden die Differenz zwischen 
dem Ausgangssi gnal (Z(k+1)) des MeBwertgebers und einem 
im Kalman-Fil ter aufgrund der vorhergehenden Messung 
ermittelten Simul ationswert (z(k+l)) gebildet wird, 

b) daB diese Differenz (Y(k+1)) jeweils durch Multiplika- 
tion mit einem einen Vektor darstel 1 enden Kalman-Ver- 
starkungsf aktor K in einen Di f f erenzf ektor x(k+l/k+l) 
umgewandelt wird, 

c) daB die Summe dieses Di f f erenzvektors 5r(k + l/k+l) und 
eines Simul ationsvektors )c(k+l/k) gebildet wird, 

d) daB dieser Summenvektor >c(k+l/k+l), der das gewunschte 
storungsarme Signal beinhaltet, nach Mul tipl ikation mit 
einer Transitionsmatrix 9 in einem Speicher als Simula- 
tionsvektor x(k+2/k+l) fUr die folgende Summenbi 1 dung 
abgespei chert wird. 
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e) und daS der Si mul ati ons vek tor x(k+2/k+l) nach Multipli- 
kation mit einem MeSvektor H als Simul a ti onswert 
z(k + 2) fiir die folgende Messung abgespei chert wird, 

wobei die K1 ammerausdriicke (k+m) bzw. (k+m/k + n) anzeigen, 
daO die entsprechende GroBe im Auswertungstak t (k+m) ver- 
wendet wird und im Auswertungs takt (k+n) gewonnen wurde, 
wobei die Trans i ti onsmatri x $ und der MeBmatri xvek tor H sich 
aus Anhang II ergeben und wobei T die Zykluszeit und J das 
Traghei tsmoment der Regelstrecke ist. 

2. Verfahren nach Anspruch 1, dadurch gekennzei chnet , daB 
der Kalman-Verstarkungsfaktor ein vorausberechneter und 
konstanter Vektor K ist. 

3. Verfahren nach Anspruch 1, dadurch gekennzeichnet, daB 
der Kalraan-Verstarkungsf aktor K (k+m) jeweils gemaB folgen- 
dein Verfahren ermfttelt wird: 

a) die transponi erte Transitionsmatrix 0^ wird rait der im 
Vorzyklus erraittelten Kovari anzmatrix P(k/k) mul tip! Iziert 
und dieses Produkt wird mit der Transitionsmatrix 0 

mul tip! iziert 

b) dieses Produkt wird zu einer Konstanten Matrix r»Q»r^ 
addiert, urn eine Voraussage fiir die neue Kon vari anzmatri x 
P(k+l/k) zu erhalten. 

c) nach Mul ti pi i k ati on dieser Voraussage mit dem transponier- 
ten variablen MeBvektor (k) wird der entstehende Vektor 
P(k+l/k) • H^(k) einerseits gespeichert und anderseits 

mit dem MeBvektor H(k) mul ti pi i zi ert 

d) der dabei entstehende Skalar wird dann zu einem weiteren 
variablen Skalar R(k) addiert und von der entstehenden 
Surame Su Reziprokwert gebildet. 
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e) mit diesem Reziprokwert wird der gespeicherte Vektor 
P(k+l/k) • H^(k) mul tip! iziert, wodurch sich der Kalraan 
Verstarkungsvektdr K{k+1) ergibt 

f) dieser wird einerseits zur Multiplikation mit der Dif- 
ferenz 7(k+l) benutzt und andererseits mit dem variablen 
MeSvektor H(k) raul ti pi i zi ert 

g) das entstehende Produkt K(k+1) • H(k) wird von einer 
konstanten Matrix I abgezogen. 

h) diese Differenz I - K{k+1) • H(k) wird mit der gem30 b) 
ermittelten Voraussage fur den Kovarl anzraatrl x P(k+l/k) 

mul tipliziert und das Produkt als neu erraittelte Kovarianz- 
matrix P(k+l/k+l) fur den folgenden Zyklus zur VerfQgung 
gestel 1 t 

1) der variable Skalar R(k+1) fur den folgenden Zyklus wird 
durch Mul tiplikatlon des Siraul atl onsvektors x(k+l/k+l) 
mit einem konstanten Vektor S und Addition eines Skalars 
R^zu dem durch die Multiplikation erhaltenen Skalar 
5(k+l/k+l) • S gewonnen 

k) die variablen MeBvektoren H (k+1) fur den folgenden 
Zyklus werden durch Multiplikation des ermittelten 
Simul ationswertes z(k+l) mit einem Vektor M (k+1) gewon- 
nen, wobei sich der Vektor M (k+1) aus dem geschatzten 
Zustand x(k+l/k+l) und den konstanten Skalaren «o» * 
und MZ ergibt- 
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4. Verfahren nach einem der Anspriiche 1 bis 3, dadurch ge- 
k ennzei chnet i daB die Radbeschleuni gung b(k) aus der Be- 
zi ehung 

b(k = ?3(k/k)/J 
ermittelt wird, wobel sich X3 aus x(k/k) ergibt. 
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Verfahren zur Umwandlung des Ausgangssi gnal s eines 
Drehgeschwindlkei tsmeSwertgebers in ein storungsarmes Signal 

Die Erfindung betrifft ein Verfahren zur Umwandlung eines in 
seiner Amplitude und Frequenz von einer zu erraittelnden 
Drehgeschwindigkei t abhangigen, storbehaf teten si nu sf ormi gen 
Ausgangssi gnal eines Drehgeschwi ndi gkei tsmeSgebers in ein 
storungsarmes Signal . 

Bei Antibl ocker-Systemen wird die Radgeschwindi gkei t ge- 
braucht. Dazu wird in den herkomml i chen Systeraen meist ein 
elektromagnetischer MeBwertgeber eingesetzt. Dieser besteht 
aus einem Zahnkranz und einem Polstift. Der Zahnkranz ist 
am Rad befestigt und dreht sich mit dem Rad. Der Polstift 
ist an der Achse befestigt. Bei Raddrehung wird am Polstift 
eine Mechsel spannung induziert. Die Frequenz der Wechsel* 
spannung wird von der Radgeschwi ndi gkei t und von der Zahne- 
zahl des Zahnkranzes bestimmt. Wenn ein Zahn des Zahnkranzes 
sich gegenUber dem Polstift befindet,, so ist die Spannung 
positiv und umgekehrt^ wenn eine ZahnlUcke sich gegenuber dem 
Polstift befindet so ist die Spannung negativ. Diese Eigen- 
schaft wird nun so ausgenutzt, daB die Zeit zwischen zwei 
umgekehrt aufeinander folgenden Nul 1 durchgangen gemessen 
wird. Diese Zeit ist proportinal zur Radgeschwi ndi gkei t. 

Fur die Zeitmessung der Null durchgange wird die Wechsel- 
spannung verstarkt und durch einen Begrenzer geschickt> 
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welcher die Spannung nach oben und nach unten begrenzt. Der 
Vers tarkungsfak tor ist sehr groB gewahlt, sodaB ein Recht- 
ecksignal entsteht. Die Nul 1 durchgange werden dann durch 
Spannungssprlinge si gnal i si ert . Damit Storungen in der Wech- 
selspannung die Messung nicht beei nf 1 ussen , ist der Verstar- 
kereingang mit einer Hysterese versehen. 

Die Amplitude der Wechsel spannung ist auBer von der Radge- 
schwindigkei t auch noch von der Spalt zwischen Polstift und 
Zahnkranz abhangig. Die Amplitude der Wechsel spannung nimmt 
mit der Radgeschwi ndi gkei t zu und mit Spal tvergroBerung ab* 
Die Information, welche in dem Wechsel spannugssi gnal ent- 
halten ist, wird durch Spannungsbegrenzung ira Verstarker zum 
Teil geloscht. Ein Problem sind die Toleranzen, rait denen die 
Sensorteile gefertigt werden. Dadurch sind die Abstande 
zwischen den Zahne.n des Zahnkranzes nicht exakt gleich, und 
es konnen bei hoher Geschwi ndi gkei t groBe Sprtinge in der 
berechneten Radgeschwi ndi gkei t auftreten. Spezielle logische 
E ntschei dungen , welche die physi kal i schen Gesetze beriicksich- 
tigen, begrenzen diese SprUnge und filtern auf diese Weise 
die Radgeschwi ndi gkei t. Ein weiteres Problem sind Storungen, 
welche gerade die Ei ngangsschwell e des Verstarkers iiber- 
schreiten. Wenn die Frequenz dieser Storungen groB ist, aber 
nicht groB genug urn al s Storung bei der logischen Prlifung 
erkannt zu werden, dann wird diese Storung fur die Radge- 
schwi ndi gkei tsberechnung ausgewertet und das kann zum feh- 
lerhaften Funk ti onieren, des Anti bl ockierregel systems 
fuhren. 

Mit der vorliegenden Erfindung wird ein Verfahren angegeben, 
mit dem diese Probleme ausgeblendet oder zumindest gedampft 
werden konnen, Dazu wird ein stati sti scher Beobachter, ein 
sogenanntes Kalman Filter, benutzt. Hauptbestandtei 1 e des 
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Filters sind die Simulation der dynamischen Raddrehung und 
die Nachbildung des Sensor-Wechsel spannungssi gnal s . Das 
Filter e'nthalt dabei durch die Simulation der Raddrehung 
automatisch die phy si kal i schen Gesetze- Die Begrenzung des 
verstarkten Signals entfallt, sodaB neben der Frequenz auch 
die Information, die in der Amplitude des Signals enthalten 
ist, nun vorteilhaft ausgewertet wird. Es wird ein genaueres 
Geschwindi gkeitssignal ermittelt als es mi t der herkomm- 
lichen MeBmethode moglich war. Dies hat zur Folge, daQ 
groBere Toleranzen in der Herstellung der Sensorteile zuge- 
lassen werden korinen* Auch andere Zahnforraen als die her- 
kommliche Zahnform mit rechteckigem Querschnitt, Oder ganz 
andere Sensoren deren Signale matheraatisch gut nachgebildet 
werden konnen, sind erlaubt. 

Weiter entfallt die nachgeschal tete Berechnung der Radbe- 
schleunigung, da auch diese GroSe vom Kalman Filter abge- 
schatrt wird. Das erf i ndungsgemaBe Yerfahren kann mit 
analdgen und digitalen Schal tmi ttel n realisiert werden* 

Anhand der Ausf uhrungsbei spi ele der Zeichnung wird die Er- 
findung naher erlautert. Es zeigen 

Fig* 1 - ein erstes Ausf uhrungsbei spiel der Erfindung, bei 
dem ein vorausberechneter Konstanter Kalman Ver- 
starkungsf aktor unterstellt ist. 

Fig. 2 - ein Ausf uhrungsbei spiel , bei dem der Kalman-Ver- 
starkungsf aktor laufend neu berechnet wird. 

Fig. 3-5 - Diagramme zur Erlaiiterung, 
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In Fig. 1 gibt ein Sensor 1/2 eine Spannung ab, welche hier 
proportional zu einer Radgeschwi ndi gkei t sei . In einem 
Block 3 wird diese Spannung verstarkt und in einem Wandler 4 
di gital isiert. Vora Sensorsignal 2(k+l) am Ausgang des 
Wandler 4 wird im Subtrahierer 5 ein sirauliertes MeBsignal 
z (k+1) abgezogen. Das Di f f erenzsi gnal T(k+1) wird mi t dem 
Kalman Vers t3rkungsvek tor K in einen Block 6 mu 1 ti pi i zi ert . 
Das Produkt ist der ges.chatzte Fehler in der Simulation des 
Systemzustand, x(k+l/k). In einem Addierer wird diese Korrek- 
tur zum simulierten Systemzustand x(k+l/k) addiert. Die 
Summe ist der geschatzte Systemzustand x(k+l/k+l) d.h. ein 
Signal, das den zu bestimmenden MeBwert,aber mit weniger 
Storungen behaftet ,beinhaltet. 

Dieser geschatzte Systemzustand wird mit dem Transistions- 
matrix im Block 8 mul ti pi i zi ert und das Produkt x(k+2/k+l) 
einem Speicher 10 zugefiihrt. In Block 9 wird dieses Produkt 
noch mit dem MeSvektor H mul tipl iziert und das Ergebnis, das 
geschatzte Sensorsignal z(k+2) in einem Speicher 11 ge- 
speichert. Danach wird der nachste Zyklus begonnen. 

Durch die angenomraene lineare Auslegung des Sensors 1/2 
kann hier der Verstarkungsvektor K al s Konstant angenomraen, 
im voraus berechnet und im Block 6 gespeichert werden. 
Dieser konstanter Vektor erhalt den asyraptoti schen Wert von 
K(k) d.h. K = lim (K(n)). 

n ->• » 

Fig. 2 zeigt ein weiteres Ausfuhrungsbei spiel . 
Die Berechnungen sind hier in 5 Abschnitte I-V unterteilt. 
Diese Abschnitte sind durch waagerechte gestrichelte Linien 
in Fig. 2 eingetragen. Die Berechnungen beginnen in Abschnitt 
I und verlaufen iiber Abschnitte II, III, lY nach Abschnitt V. 
Nach Abschnitt V folgt im nachste Zyklus wieder Abschnitt I. 
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Links unten in Fig. 2 sind Sensortelle, ein Zahnkranz 21 und 
ein Polstift 22 schematisch dargestellt. Die induzierte Sen- 
sor-Wechsel spannung wird in einem Verstarker 23 verstarkt 
und in einem Wandler 24 di gi tal i siert. Diese di g1 tal i s i erte 
Sensor-Wechsel spannung wird nun Sensorsignal z(k+l) genannt. 
In einem Subtrahierer 25 wird von dem Sensorsignal z(k+l) 
ein simuliertes Sensorsignal z{k+l) aus einem Speicher 56 
abgezogen. Dieses Di f f erenzsi gnal z'(k + l) wird in einem Mul- 
tiplizierer 26 mit dem einen Vektor K(k+1) darstellenden 
Kalraan-Verstarkungsf aktor mul tip! i zi ert. Die AusgangsgroBe 
ist ein Dif f erenz-Vektor x(k+l/k+l); dies ist ein Signalvek- 
tor, welcher aus mehreren separaten Signalen besteht. Iro 
Addierer 27 wird zu dem Di f f erenzvektor der siraulierte Zu- 
standsvektor ^k+l/k), der Ausgang eines Speichers 57, 
addiert und. damit der geschatzte Zustand des Rads x{k + l/k + l) 
gebildet. Dieses Signal belnhaltet die entstorte gesuchte 
MeBgrSBe. Durch. Mul tiplikation des geschatzten Zustands mit 
dem MeBvektor H(k+1) erhSlt man das MeBsignal das der ent- 
stSrten Radge^ihwindi gkeit entspricht. 

Der Vektor K(k+1) wird die Kalman Verstarkung genannt. Die 
Verstarkungsf aktoren sind zeitabhangig und werden in Abhan- 
gigkeit von den Stor-und Messignalen berechnet. Zur zeitab- 
hangigen Berechnung der variablen Kal man-Verstarkungsf akto- 
ren dienen die Abschnitte I - II und V. 

Im Abschnitt I sind 9^ y « und rQr^ konstante Matritzen, wobei 

die transponi erte Matrix von « ist. P(k*k) ist eine va- 
riable Matrix. aus einem Block 90, wird mit P(klk) (ira 
Block 31) multipliziert, und das Produkt anschlieBend noch 
roal mit « in Block 32 raultipliziert. Das Ergebnis wird ira 
Addierer 33 zur Matrix rQr^ aus Block 34 addiert. Die Summe 
P(k+l/k) wird in B15cken 36 und 46 gespeichert. Damit ist 
die Berechnung in Abschnitt I abgeschlossen. 
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Iin Abschnitt II sind H(k), und P(k+l/k)H ' (k) variable Vek- 
toren^P{k+l/k ) eine variable Matrix und R(k) ein variabler 
Skalar. Der Vektor (k) aus Block 35 wird mit der Matrix 
P{k + ljk) des Blocks 36 mul ti pi i zi ert und das Ergebnis wird 
im Block 41 gespeichert, bzw. mit H(k) im Block 37 multi- 
pliziert. Der Ausgang des Blocks 37 ist ein Skalar, der in 
einen Block 39 zum Skalar R(k) aus Block 18 addiert wird. 
In einem Block 40 wird der Reziprokwert dieser Sumrae S^ ge- 
bildet. Die Berechnungen in Abschnitt II warden abgeschlos- 
sen mit der Mul ti pi i kati on der Skal arreziproken mit dem 
Vektor P{ k+l/k ) H^( K ) aus Block 41 und mit der Speicherung 
des Produktes K(k+1) in Blocken 43 und 26. 

In Abschnitt III ist I eine konstante Ei nhei tsraatri x; 
P{k + l/k.) und I-K (k+l)H(k) si nd * vari abl e Matrizen. H(k) und 
K{k+1) sind Variable Vektaren. Der Vektor H(k) aus Block 42 
wird mit dem Vaktor K(k+1) in Block, 43 mul tip! i ziert und das 
Produkt, eine Matrix, von der konstanten ^Matri x I aus 
Block 44 im Block 45 subtrahi ert. Die Differenz I-K (k+l)H{k) 
wird in einem Speicher 58 gespeichert. Danach wird die 
Matrix P(k+l/k) aus Block 46 mit dieser Di f f erenzmatri x in 
Block 58 mul tip! iziert und das Ergebnis P(k+l/k+l), in dem 
Block 31 abgespeichert. 

Nach AbschluS der bereits geschi 1 derten Berechnungen in 
Abschnitt IV wird in Abschnitt V der geschatzte Zustand 
1!(k + l/k+l) im Block 47 mit einem Vektor S muTti pi i zi ert und 
das Produkt, ein Skalar^ im Addierer 48 zu dem Skalar Rq des 
Blocks 49 addiert. Die Summe R(k+1) wird in Block 38 ge- 
speichert. Weiter wird noch der Vektor H{kfl) berechnet. 
Dazu wird das simulierte Sensorsignal z(K+l) und der geschatzte 
Zustand x(k+l/k+l) herangezogen . In einem Block 50 ist das 
simulierte Sensorsignal z(k+l) gespeichert. Dieses wird im 
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Block 52 mit dem Vektor M(k+1) mul t1 pi i zi ert . Der Vektor 
M(k+1) wird aus dem geschatzten Zustand x{k+l/k+l )^ der im 
Speicher 51 abgespei chert ist^und aus den konstanten Skala- 
ren (Block 53), A (Block 54), und NZ (Block 55) berech- 
net. Das Produkt ist der neue Vektor H(k+1), der in den 
Blocken 29,35,37 und 42 ei ngespeichert wird. Der geschatzte 
Zustand x{k+l/k+l) wird noch in Block 28 mit der Transi ti- 
onsmatrix c&, welche das Radverhal ten simuliert, multipli- 
ziert. Der Ausgang ist dann der siraulierte Radzustand 
x{k+2/k+l). In Block 29 wird der siraulierte Radzustand 
x(k+2/k+l) mit dem MeBvektor H(k+1) mul ti pi i zi ert, um das 
siraulierte Sensorsignal z(k+2) fUr die Speicher 50 und 56 
zu erhalten. 

Erst wenn der nachste Zyklus anfSngt, wird der A/D-Wandler 
24 angestoQen und der neue Wert des Sensorsi gnal s z(k+2) 
gespeichert. Die Frequenz des A/D - Wandler muS also an der 
Rechengeschwindigkei t des gesamten Rechenwertes angepaQt 
sein. Um jedoch eine akzeptable Zahl der Abtastpunkte inner- 
halb einer Si gnal peri ode zu erreichen, rauQ die Abtastfre- 
quenz hoch genug gewahlt werden. Wenn davon ausgegangen wird, 
daB der Zahnkranz 50 Zahne hat, und daS die maximale Oreh- 
zahl des Rades 60 Umdrehungen pro Sekunde nicht uberschrei- 
tet, muB die Abtastf requenz mindestens 6 KHz betragen, um 
auch bei hochster Geschwindi gke1t eine sichere Funktlon des 
Filters zu gewahrl ei sten. Dies bedeutet wiederum daB der 
Rechner die Berechnungen eines Zyklus innerhalb von 0,16 
Millisekunden ausfuhren muB. Nach diesera Kriterium ist der 
Rechner zu wahlen. Bel niedrigeren Drehzahlen und bei nle- 
drigeren Zahnezahlen kann die Abtastf requenz entsprechend 
gerlnger gewahlt werden. 

In der Fig. 1 u. 2 stellen die einfach gezeichneten Verbin- 
dungen zwischen den Blocken Ei nf achverbi ndungen, die doppelt 
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gezeichneten Verbi ndungen Mehrf ach verbi ndungen dar. Die 
einzelnen Matrizen und Vektoren sind im Anhang II auf Setten 
12-14 aufgelistet. Die Bezel chnungen fur die einzelnen ver- 
wendeten Symbole sind im Anhang I auf Seite 11 angegeben. 

BEISPIELE 

In Fig. 3, und Fig. 4. sind Diagramme gezeigt. 
In beiden Figuren ist die obere Kurve die Sensorspannung 
nach dem A/D • Wandler, wobei die digitalen Werte linear 
miteinander verbunden sind. Diese Kurven sind MeBauf nahmen . 
Unterhalb der Sensorspannung ist die vom Kalman Filter aus- 
gerechnete Randumf angsgeschwi ndi gkei t gezeichnet. Fig. 3 
zeigt das Ergebnis bei einer hohen Abtastrate, wahrend Fig. 4 
das Ergebnis bei einer niedrigen Abtastrate zeigt. In beiden 
Berechnungen ist im Vektor S R 1 = 0 gewahlt. 

, Im Beispiel der Fig. 3 blockiert das Rad zwischen 90 und 
300 Mi 1 1 i sekunden. Das Kalman Filter zeigt dies auch recht 
zuf r1 edenstell end an. Die starke Schwingung in der Geschwin- 
dikeit am Anfang der Fllterung ist das Einschwingen des 
Filters. 

Im Beispiel von Fig. 4 blockiert das Rad zwischen 110 und 
210 Mi 11 i sekunden. Auch hier funktloniert das Kalman Filter 
zuf r1 edenstell e,nd trotz der niedrigen Abtastrate. 

Es folgen Erlauterungen zu den Berechnungen des Kalman- 
Filters. Der geschatzte Zustand des Systems ist; 



Xi = Rad-Drehwi nkel 

X2 = Rad-Drehgeschwi ndi gkei t 

X3 = Rad-Drehmoment 

X4 = Reziproke des Sensor-Spal tabs tands 
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Die Systeragl eichungen lauten : 



X2 

X3 /J 

Wl 

W2 



wobei Wl und W2 die Rauschpegel des Rad-Orehraoments bzw, 
Reziproken des Sensor-Spal tabstandes sind. 

Die diskrete Systeralosung lautet: 

x{k+l) = * (k+l/k) . x(k) + r (k+l/k) • W(k) 



wobei 



w(k) 



0 
0 

Wl (k) 
W2 



Das Sensorsignal stent sich wie folgt dar: 



ist. 



z = X4 • 



sin (Xi • NZ) d-e"*) (1 + A Xg) +.r(t) 



wobei r(t) das St5rsignal im Messignal ist. 

Diese Gleichung bildet den generellen Verlauf der Sensor- 
spannung mit Zahnezahl NZ. der Reziproken des Spal tabstandes 
X4 und mit der Drehzahl X2 ab. Die Abhangigkeit der Wechsel- 
spannungsainplitude Ugs in Abhangigkeit von der Raddrehzahl ai 
und dera Spaltabstand s zei gt Fig. 5. 
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Das diskretes Sensorsignal ist: 

2(k+l) = H(k) . x(k+l) + r(k) 
Die Radbeschleum'gung b{k) ergibt sich zu 

b (k) = X3 (k)/j 

Man kann also hier auch in einfacher Weise die Radbeschleu- 
nigung ermitteln. 

SCHT^TZALGORITHMUS 

Kovari anzmatri x: 

P(k + l/k) = $ . P(k/k)» *^ - r • Q -r""" 

Kalmanverstarkung: 

K(k+l) = P(k+l/k)-H"'" {k).[H(k)-P(k+l/k)»H"'"(k) + R(k)]-^ 
Kovari anzmatri x: 

P(k+l/k+l) = [I-K(k+1) • H(k)] • P(k+l/k) 
Systemzustand: 

x{k + l/k + l) = ^.jTck+l/k) + K(k+l/k).[z(k+l)-H(k).«.x(k/k) j 
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Anirang I 

Benennungen der verwendeten GroBen 



T Zykluszeit 

J Traghei tsmoment des Regelstrecke (Rad) 

Qj^ Varianz des Moments 

Varianz der Reziproken des Spal tabs tands 
R Varianz des Sensorsi gnal rauschens 

Xj^ geschatzter Zustand Raddrehwi nkel 

X2 geschatzter Zustand Raddrehgeschwl ndi gkei t 

X3 geschatzter Zustand Raddrehmoment 

X4 geschatzter Zustand des reziproken Sensor- 

Spal tabstands 

Grundvarianz des Sensorsi gnal rauschens 
Wq Sensorkonstante (eriai ttel bar aus Fig. 5) 

A Sensorkonstante (ermi ttel bar aus Fig. 5) 

NZ Zahnezahl des Ro±ors des Sensors 

Sensorkonstante ( geschwi ndi gkei tsabh'angi ge 

Varianz des Sensorsi gnal rauschens ) 

pi } 

^2 ^ Anfangsvarianzen der Zustandsvari abl en 

P3 } 
P4 } 

Rauschpegel des Raddrehmoments 
W2 Rauschpegel der Reziproken des Sensor Spalt-^ 

abstandes 
r(t)* Storsignal im MeBsignal 

b(lc) Radbeschl euni gung 



Die Varianzen miissen geschickt gewahlt werden. 
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Anh.ang II 

1) BELEGUNG DER KONSTANTEN BLOCKE 

Im folgenden ist T di e Zykluszeit, J des Traghei tsraoment des 
Rads um seine Achse, Qi die Varianz des Moments auf das Rad 
uro die Radachse, Q2 die Varianz der Reziproken des Spaltes 
zwischen Polstift und Zahnkranz des Sensors, R die Varianz 
des Sensorsignal rauschenr ; xi - X4 1st der geschatzte 
Zustand des Rads. Der Superscript T zu einer Matrix Oder 
einem Vektor bedeutet die transponi erte Matrix bzw. Vektor 
(z.B. «"•"). 



1,1: Transistormatrix 0 des Systems 



« = 



1 
0 
0 
0 



T 
1 
0 
0 



T /(2J) 
T/J 
1 
0 



0 
0 
0 
1 



1.2 Matrix des Blocks 34 (r • Q • r^) erglbt sich aus 



r - 



T 
0 
0 
0 



T/(2J) T/(6J) 
T T/(2J) 



0 
0 



T 
0 



0 
0 
0 
T 



Q = 



0 
0 
0 
0 



0 
0 

Ql 
0 



0 
0 
0 

Q2 



i? - 




-1? 



1.3: 

I denti tatsmatri X I 



1 



0 



0 



0 



0 



0 



I = 



1 



0 



1 



1.4: Konstanten 

Block (29): Rq ( Srundvari anz Sensorslgnalrauschens) 
Block (33): Wq (Sensorkonstante) 
Block (34): A (Sensorkonstante) 
Block (35): MZ (Zahnezahl ) 

1.5: Vektor S 



S = 



2) BELEGUNG DER VARIABLEN BLOCKE 
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2.1 Transponi erter MeBvektor 



NZ cot (NZ • xx) 



•/e^t- 1 ) 



0 

1 

X4 



1 + A X2 



2.2 Anfangswert des Blocks 31 



P(0/0) = 



Pi 
0 

0 

0 



0 

0 
0 



0 
0 

P3 



0 
0 
0 

P4 



wobei Pi - P4 die Anf angsvari anzen der Zustandsvari ablen 
sind. 
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